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Description 

METHOD FOR DETERMINING A 
LONGITUDINAL VEHICLE VELOCITY BY 
COMPENSATING INDIVIDUAL WHEEL 
SPEEDS USING PITCH ATTITUDE 

Cross Reference to Related Applications 

[0001] The present invention claims priority to provisional appli- 
cation no. 60/450,143, filed on February 26, 2003, and is 
related to patent application serial no. 10/041,246, filed 
January 8, 2002, the disclosure of which is incorporated 

by reference. 
Background of Invention 

[0002] The present invention relates generally to dynamic control 
systems for automotive vehicles and, more specifically to 
a system that compensates wheel speed sensor signals to 
determine a vehicle reference velocity. 

[0003] It is a well-known practice to control various operating 
dynamics of a motor vehicle to achieve active safety. Ex- 



amples of active safety systems include traction control, 
yaw stability control and roll stability control systems. A 
more recent development has been to combine all the 
available subsystems to achieve better vehicle safety and 
dynamics performance. The effective operation of the var- 
ious control systems requires high-accuracy and fast- 
response-times in the determination of the operating 
states of the vehicle, regardless of road conditions and 
driving conditions. Such vehicle operating states include 
the vehicle longitudinal, lateral and vertical velocities 
measured along the body-fixed longitudinal, lateral and 
vertical axes, the attitude of the vehicle body, and the 
travel course of the vehicle. 
[0004] One piece of basic information that forms the aforemen- 
tioned vehicle state estimation is the linear velocity of the 
rotating centers of the four wheels. For example, this in- 
formation can be used to assess the wheel slip used in 
anti-lock brake controls and traction controls and to esti- 
mate the longitudinal velocity of the vehicle. In order to 
obtain the linear corner velocities, the wheel speed sen- 
sors are used. The wheel speed sensors output the prod- 
ucts of the wheel rotational speeds and the rolling radii. 
The wheel rotational speeds are directly measured and the 



rolling radii are assumed their nominal values. During dy- 
namic maneuvers, the variations of the wheel normal 
loading will affect the rolling radii. Hence, the nominal 
rolling radii may not reflect the actual rolling radii and 
thus cause errors in the calculation of the wheel speeds. 
[0005] The determination of the longitudinal velocity is also af- 
fected by gravity. That is, if the vehicle is on a pitched 
road, gravity may affect some of the readings from the 
acceleration sensors, such as the lateral acceleration sig- 
nal. 

[0006] It would therefore be desirable to provide a more accurate 

way in which to determine the vehicle speed taking into 

consideration changes in rolling radii. 
Summary of Invention 

[0007] The present invention provides an improved determina- 
tion of the individual wheel speeds. In the present inven- 
tion the individual wheel speed calculations may be com- 
pensated for by learning the rolling radii of the wheels. 
Thus, a more accurate determination of the vehicle refer- 
ence velocity or the longitudinal velocity may be deter- 
mined. 

[0008] In one aspect of the invention, a control system for con- 
trolling a safety system of an automotive vehicle includes 



a plurality of wheel speed sensors generating a plurality of 
wheel velocity signals, a steering angle sensor generating 
a steering actuator angle signal, a yaw rate sensor gener- 
ating a yaw rate signal, a longitudinal acceleration sensor 
generating a longitudinal acceleration signal and a pitch 
angle generator generating a pitch angle signal and a 
controller. The controller generates a longitudinal vehicle 
velocity in response to the plurality of wheel speed sig- 
nals, the steering angle signal, the yaw rate signal, the 
lateral acceleration signal and the pitch rate signal. The 
controller may determine a slip-related longitudinal ve- 
locity and a non-slip longitudinal velocity as intermediate 
steps. 

[0009] In a further aspect of the invention, a method of control- 
ling a safety system for an automotive vehicle having a 
plurality of wheels includes determining a non-slip longi- 
tudinal velocity, determining a slip-related longitudinal 
velocity, determining a longitudinal velocity of the vehicle 
in response to the non-slip longitudinal velocity and the 
slip related longitudinal velocity, and controlling a safety 
system in response to the longitudinal velocity. 

[0010] One advantage of the invention is that the pitch attitude 
can be taken into consideration resulting in a more accu- 



rate longitudinal velocity determination. 
[0011] Other features of the present invention will become ap- 
parent when viewed in light of the detailed description of 
the preferred embodiment when taken in conjunction with 

the attached drawings and appended claims. 
Brief Description of Drawings 

[0012] Figure 1 is a top view of a motor vehicle illustrating vari- 
ous operating parameters of a vehicle experiencing a 
turning maneuver on a road surface. 

[0013] Figure 2 is a side view of a motor vehicle wheel illustrating 
various operating parameters of the wheel. 

[0014] Figure 3 is a block diagram showing a portion of a micro- 
processor interconnected to sensors and controlled de- 
vices, which may be included in a system according to the 
present invention. 

[0015] Figure 4 is a control system block diagram in accordance 

with the present invention. 
Detailed Description 

[0016] In the following figures the same reference numerals will 
be used to illustrate the same components. 

[0017] Referring now to Figure 1, various operating parameters 
and variables used by the present invention are illustrated 



as they relate to the application of the present invention 
to a ground based motor vehicle 10 having wheels 12, 14, 
16, 18. Those skilled in the art will immediately recognize 
the basic physics represented by these illustrations, 
thereby making the adaptation to different types of vehi- 
cles easily within their reach. Lateral and longitudinal ve- 
locities of the center of gravity are denoted as V and V , a 

X y 

yaw angular rate is denoted as oo^, a front wheel steering 

angle is denoted as 5, lateral acceleration is represented 

by a , and longitudinal acceleration is represented by a . 
y X 

[0018] Using those vehicle motion variables, the velocities of the 
vehicle at the four corner locations, where the wheels are 
attached to the vehicle, can be calculated. The velocities 
are projected along the body fixed longitudinal and lateral 
directions 

where t and t are the half tracks for the front and rear 

f r 

axles, I and I are the distances between the center of 

f r 

gravity of the vehicle and the front and rear axles. The 
variables V , V , V and V are the linear velocities of the 

If rf Ir rr 



four corners along the wheel heading directions (left front, 
right front, left rear and right rear, respectively), which 
can be calculated in the following 

n/=V^.cos(^) + y^,sin(^ ^2) 
V -V 

rr rrx 

[0019] Substituting (1) into (2), the following is obtained 

- (V^. + co.tj: ) cos( J) + + CO J J ) sm{S) ^ ^ 

[0020] Considering 

Vy=V^tm(fi), (4) 

[0021] Therefore, equation (3) can be used to compute both V 

X 

and p. Since there are two unknowns and four constraints 
in equation (3) , there are several ways of computing 
and 3- 

[0022] Referring now to Figure 2, vehicle corner velocity along 

the wheel longitudinal direction is equal to the sum of the 
contact patch slip velocity v and the product of the 

cp 

wheel rotational rate oo and its rolling radius r . 

whi o 

[0023] Referring now to Figure 3, stability control system 24 has 



a controller 26 used for receiving information from a 
number of sensors which may include a yaw rate sensor 
28, speed sensors 30 (at each wheel), a lateral accelera- 
tion sensor 32, a roll rate sensor 34, a steering angle 
(hand wheel position) sensor 35, a longitudinal accelera- 
tion sensor 36, a pitch sensor 37, and steering angle po- 
sition sensor 39. Steering angle position sensor 39 senses 
the position of the steered road wheels. Lateral accelera- 
tion, longitudinal acceleration, yaw rate, roll orientation 
and speed may also be obtained using a global position- 
ing system (GPS). Based upon inputs from the sensors, 
controller 26 controls the safety system 40. Depending on 
the desired sensitivity, the type of safety system and vari- 
ous other factors, not all the sensors 28-39 may be used 
in a commercial embodiment. Other factors may be ob- 
tained from the sensors such as the surface mu and the 
vehicle side slip angle, 3- 
[0024] Roll rate sensor 34 and pitch sensor 37 may sense the roll 
condition to be used with a rollover control system as an 
extension of the present application. The pitch sensor 37 
may be part of a pitch angle generator that generates a 
pitch angle (longitudinal slope of the vehicle) of the vehi- 
cle. In some cases the pitch angle may be measured di- 



rectly by the pitch sensor if it is a pitch angle sensor. 
However, for a high volume application such pitch angle 
sensors are typically cost prohibitive. A pitch rate sensor 
signal may be used to determine the pitch angle. This may 
be performed in a stand alone unit or within controller 26. 
Of course, other ways of determining pitch angle may be 
used. 

[0025] Safety system 40 may be a number of types of safety sys- 
tems including a roll stability control system, a yaw con- 
trol system, antilock brakes, traction control, airbags, or 
active suspension system. Each of the types of safety sys- 
tems 40 use the longitudinal velocity for various calcula- 
tions. Those skilled in the art of safety systems will appre- 
ciate the specific use. 

[0026] Safety system 40, if implemented as roll control, may con- 
trol a position of a front right wheel actuator, a front left 
wheel actuator, a rear left wheel actuator, or a right rear 
wheel actuator. Although, as described above, two or 
more of the actuators may be simultaneously controlled 
as one actuator. Based on the inputs from sensors 28 
through 39, controller 26 determines the vehicle dynamic 
condition and controls the safety system. Controller 26 
may also use brake control coupled to front right brakes. 



front left brakes, rear left brakes, and right rear brakes to 
dynamically control the vehicle. By using brakes in addi- 
tion to steering control to prevent rollover some control 
benefits may be achieved. For example, yaw control and 
rollover control may be simultaneously accomplished. 
[0027] Speed sensor 30 may be one of a variety of speed sensors 
known to those skilled in the art. For example, a suitable 
speed sensor may include a sensor at every wheel that is 
averaged by controller 26. As will be described below, the 
controller 26 translates the wheel speeds into the speed 
of the vehicle. 

[0028] Referring now to Figure 4, a method of operating a safety 
system using a corrected vehicle velocity is determined. In 
step 60 the wheel speed sensors are read. In one embodi- 
ment each wheel has a separate speed sensor. In step 62 
the other sensors applicable to the system are read. In 
step 64 a plurality of non-slip longitudinal velocities are 
determined. Slip related longitudinal velocity is described 
further below. As is described below, one of many differ- 
ent calculations may be performed and selected from the 
non-slip longitudinal velocity determination. 

[0029] The average front corner speed as V and the rear av- 

f-ave 

erage corner speed is defined as V , i.e. 

r-ave 



V -Yi^ 

^ f-ave 

^ . (5) 

r-ave ^ 



[0030] Then equation leads to 

f-ave = Icos(<?) + sin(<J) tan(/?)] + ty,/^ sin( J) 



(6) 



which can be used to construct the side slip angle as in 
the following 

p = tan { } . ( 7 ) 

[0031] Notice that the vehicle side slip angle 3 can only be com- 
puted from when the vehicle steering angle is non-zero. If 
the steering angle is around zero, the method proposed in 
Ford patent application no. 10/041,246 filed January 8, 
2002 (Attorney Docket No. 200-1776/FGT-1566), the 
disclosure of which is incorporated by reference, may be 
used. One method set forth therein is 

I^CO. -J.df + M.+tfM [ ay - g 5m(0^ ) cos(0„ )] 

[0032] Or in digital environment 



where is the yaw moment generated from actuators, 
is the cornering stiffness at the rear axle. 
[0033] In this example six ways are set forth for computing the 

longitudinal velocity from the four corner speeds V^, V^^, V ^ 
and V^^ . These can be summarized in the following 



2 

cos(<^) + sin(y5)sin(<y) 



+ CO,\tj cos(^) " I J sm((^)] 
cos(^) + sin(y5) sin(<y) 



cos(J) + sin(/?)sin{<^) 

= yir + ^z^r 
yxl=yrr-<^z^r 

and all of those computations should be equal (nearly, in 
a practical sense) to the actual longitudinal vehicle speed 
V , i.e. 

X 

V^=V^., for i = l,2,...,6. (10) 

[0034] Notice that equation (9) is true for all driving and road 

conditions due to the fact that they are from the kinematic 
relationships between motion variables. 



[0035] From the longitudinal velocity, the four vehicle corner ve- 
locities V , V , V and V may be computed. The corner 

If rf Ir rr 

velocities can be measured by mounting four velocity sen- 
sors on the four wheels, which sense the longitudinal ve- 
locities of the center of the wheels along the heading di- 
rections of the wheel (or the wheel longitudinal direc- 
tions). The velocity sensor may be further replaced by four 
acceleration sensors, which sense the linear acceleration 
of the center of the wheels along the heading directions of 
the wheels. 

[0036] As mainly considered here for a vehicle without the afore- 
mentioned corner velocity sensor or corner acceleration 
sensors, the available sensors are the wheel speed sen- 
sors used in anti-lock brake systems. Those ABS wheel 
speed sensors measure the rotational speed of the 
wheels. The wheel speed sensor outputs usually are cali- 
brated for providing the linear directional velocities v 

, V , V and v by multiplying the 

sensor=lf sensor-rf sensor-lr sensor-rr 

wheel rotational angular speed with the nominal rolling 
radii of the wheels as is shown in Figure 2. Notice that the 
wheels experience not only the rotational motion but also 
the linear sliding motion or longitudinal slip. The longitu- 
dinal slip is caused by the relative motion between the 



wheel and the road at the contact patch. 
[0037] If the longitudinal velocities of such relative motions at 
the contact patches are denoted as v , v , v and 

cp-lf cp-rf cp-lr 

V , then the vehicle corner velocities can be expressed 

cp-rr 

as the sums of two speeds as in the following 

/ , ill) 

Ir cp-lr sensor-lr^ rr cp—rr sensor— rr 

[0038] If there is no slip on the four wheels, v , v , v 

cp-lf cp-rf cp-lr 

and V should all be zero, and the wheel speed sensors 

cp-rr 

provide the exact characterization of vehicle corner 
speeds. Hence the equations in (9) can be used to esti- 
mate vehicle side slip angle and the instantaneous longi- 
tudinal velocity. 
[0039] ifv ,v ,v and V are non-zero, but whose 

cp-lf cp-rf cp-lr cp-rr 

magnitudes are all fractions of the magnitudes of v 

, V , V and v , then the mini- 

sensor=lf sensor-rf sensor-lr sensor-rr 

mum of the six calculated variables can be used to char- 
acterize the vehicle longitudinal velocity as in the follow- 
ing 

V, = mini V_,, , ' V;-3 , K-4 ' ^5 ' ^^-6 } (12) 



where 



^ y% ^ ^ ^ A 



are similarly computed as in equation (9) but with the 
sensor signals replacing the corner velocities as in the fol 
lowing 



V ; + V 

t/ _ sensor ~ir sensor— rr 



'x2 



V.4 = 



cos(<5) + sm(^)sin(S) 

^sensor-lf ^ (^zi^f COS{S)-lf sin(J)j 

cos{S) + S!n(/?) sin(t^ 



(13) 



cos((5') + sm(jff)sm(<5') 



^^2 ~ ^sensor-rr 



[0040] Considering sin(6)sin(P) is negligible in contrast to cos(5), 
hence 



j-v 



can be further calculated independent of the vehicle side 
slip angle 



2cos(^) 

- ^,en,or-if ^^<^) + co^[t f - If ian{S)] . (14) 
^sensor-rf sec(^» ) - fwjr^ -If mn(S)] 

[0041] In order to confidently use equations (12) and (13) to 
compute the longitudinal velocity, the magnitude of the 
contact pitch slip velocities is quantitatively captured in 
step 66. The variables d and d are the contact patch ve- 

f r 

locity differences between left and right wheels in front 
and rear axles, m and m as defined as the mean value of 

f r 

the left and right wheels in front and rear axles, i.e.. 



(15) 

H ^cp~lr - \p-rr h = 



[0042] Thus defined d , d , m and m can be calculated from the 

f r f r 

known signals, including the wheel speeds, the yaw rate, 
the steering angle (at wheel) and the estimated vehicle 
longitudinal velocity as in the following 

<^f=\ ^'rr-sensor ~ ^'if -sensor " '^^z^ ^ 

'^rf -sensor +^lf -sensor _ y^^^^^^^^ ^ ^^^^^^^ tan(;ff)] - a)Jf Sm(S) \ 

2 

^r ~\ ^rr-sensor ~^Ir~sensor ~ ^0)J-r I 

_ '^Ir—sensor rr-sensor t/ 

— I ^ V ^ I 

(16) 



where can be approximately computed independent of 
the vehicle side slip angle as in the following 



V, 



rf -sensor 



if -sensor 



14 cos( J) - coJ^ sin(<?) j . 



m 



f 



(17) 



2 



[0043] Hence in step 68 if the computed quantities in equation 
(16) are all smaller than certain thresholds, i.e., 



are true for the calibrated parameters y . Y 1 Y 1 Y then 



the contact patch slip velocities are considered negligible. 
In this example, the minimum value from equation (13) is 
chosen. In step 68, if the equations in (18) are not satis- 
fied, further analysis is needed. 
[0044] One of such cases, where equation (18) is not satisfied is 
when the vehicle is driven with steady state steering. One 
example of this case is where the vehicle is on a 
corkscrew and the vehicle has very tight turn but with al- 
most constant steering input. Thus, a steady state steer- 
ing longitudinal velocity may be determined in step 72. In 
this case, if the rear wheels are negotiating the path of the 
vehicle, then the following is true for vehicle corner veloc- 




(18) 



1 



2 



3 



4 



ities 



(19) 



[0045] Based on this condition, tlie veliicle longitudinal velocity 
(based on steady state steering) can be estimated as 

^x-ss-steer = cos(^)[cos(^) - sin( J) tan(/?)] ^ ^ ° ^ 

[0046] Considering sin(6)tan(3) is negligible in contrast to cos(6), 
an approximate of equation (20) which is independent of 
the vehicle side slip angle 3 can be expressed as 

r . cos(^)sin(^) 

^x-ss-sreer ^ ^ ^ h'^z ' < 2 1 ) 

- tj COS (t^ 

[0047] If equation (18) is not satisfied and the vehicle is not in 
steady state steering, then a further correction to recover 
the errors due to the contact patch slips is needed. 

[0048] The instantaneous longitudinal velocity may be written 
as the sum of two portions: (1) the portion from the spin- 
ning of the four wheels as computed in (12), or (21); (2) 
the longitudinal sliding portion due to the wheel slip. In 
step 74, the non-slip longitudinal velocity is set as either 
that of equations (12) or (21) which is denoted as V 

x-noslip 

and is either 



/ 



or V from steps 70 or 72. 

x-ss-steer 

[0049] The portion contributed by wheel slip is denoted as at the 
slip related longitudinal velocity V , then 

x-slip 

~ ^x-tioslip ^x-slip • (22) 

[0050] The vehicle longitudinal acceleration and vehicle pitch at- 
titude information may be used to perform the correction 
of the longitudinal velocity of the vehicle and determine 
the slip related longitudinal velocity in step 76. The longi- 
tudinal acceleration sensor signal can be divided into 
three parts as in the following 

[0051] Therefore V can satisfy the following 

x-slip ^ ^ 

%-slip - yx-sUp ^^if^y^z-sensor = /(O (24) 

where 

fit) = a^-.,ensor ' 8^y ^ + ^x-nosdp tail(/?)^y,_,,„,^^ ,(25) 

[0052] The analytic solution for V can be obtained as in the 

x-slip 

following 



(26) 

[0053] A digital iterative sclieme can be derived to compute V 

^ ^ x-slip 

from equation (26) as in tlie following 

r(^ + 1) = r{/c) + im(j3(k + l))a>,.,,,,,, (k + DAT 

n(^ + l) = n(^:) + /(/r + l)/f'^+^>Ar . (2?) 

[0054] In step 78 the longitudinal velocity of the vehicle may be 
determined as: 

—nonslip 

[0055] Once the corrected longitudinal vehicle reference velocity 
is determined, the safety system 40 may be controlled us- 
ing this value. The way in which the safety system uses 
the longitudinal velocity varies depending on the type of 
safety system. 

[0056] While particular embodiments of the invention have been 
shown and described, numerous variations and alternate 
embodiments will occur to those skilled in the art. Ac- 
cordingly, it is intended that the invention be limited only 
in terms of the appended claims. 



